float64 curv
float64 MinPhiCluster
float64 MaxPhiCluster
float64 R
geometry_msgs/Pose2D p0
